/*
ESTA FUCION RESUELVE PARA EJES PERPENDICULARES LA POSICION DE UN OBJETO CON 
RESPECTO A 3 OBJETOS DE POSICIONES CONOCIDAS. Y DEVUELVE COMO RESULTADO LAS
CORDENADAS CARTESIANAS (X,Y) DEL OBJETO EN ALGUN SISTEMA METRICO.

RECIVE COMO PARAMEROS:
Xa distancia del origen de coordenadas al Objeto A, que se encuentra sobre el eje horizontal.
Yb distancia del origen de coordenadas al Objeto B, que se encuentra sobre el eje vertical.
Da distancia del Objeto A al de posicion desconocida.
Db distancia del Objeto B al de posicion desconocida.
Do distancia del origen de coordenadas de posicion desconocida.

DEVELVE:
coordenadas: la posicion x,y del objeto perdido

*/
#include "CalcPos.h"

coordenadas c;

coordenadas calcPos(float Xa,float Yb,float Da,float Db,float Do) {
  c.x = (Do*Do - Da*Da + Xa*Xa)/(2*Xa);
  c.y = (Do*Do - Db*Db + Yb*Yb)/(2*Yb);
  return c;
}
